(19) 


Europaisches Patentamt 
European Patent Office 
Office europeen des brevets 



1 


(12) 


(ID EP 1 361 459 A1 

EUROPAISCHE PATENTANMELDUNG 


(43) 

Veroffentlichungstag: 

(51) intci7: G01S 15/93, G01S 13/93, 


1 2.1 1 .2003 Patentblatt 2003/46 

G01S 17/93 

(21) 

Anmeldenummer: 03003006.8 


(22) 

Anmeldetag: 12.02.2003 


(84) 

Benannte Vertragsstaaten: 

(72) Erfinder: 


AT BE BG CH CY CZ DE DK EE ES Fl FR GB GR 

• Danz, Christian 


HU IE IT LI LU MC NL PT SE SI SK TR 

70469 Stuttgart (DE) 


Benannte Erstreckungsstaaten: 

• Uhler, Werner 


AL LT LV MK RO 

76646 Bruchsal (DE) 



• Schmid, Dirk 

(30) 

Prioritat: 08.05.2002 DE 10221339 

75397 Simmozheim (DE) 

(71) 

Anmelder: ROBERT BOSCH GMBH 



70442 Stuttgart (DE) 



(54) Fahrerassistenzsystem mit Koppelnavigation 

(57) Die Erfindung betrifft ein Fahrerassistenzsy- 
stem fiirein Fahrzeug mit 

Mitteln 3 zur Bestimmung einer ersten Position ei- 
nes Hindernisses mit Bezug auf das Fahrzeug, so- 
lange das Fahrzeug einen Mindestabstand zu dem 


Hindemis hat, 

Mitteln 2 zur Bestimmung einer zweiten Position 
des Hindernisses bei Unterschreitung des Mindest- 
abstands basierend auf einer Weg- und Lenkwin- 
kelmessung. 
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Beschreibung 

[00011 Die Erfindung betrifft ein FahrerassistenzsysU .n, insbesondere eine Einparkhilfe oder einen sogenannten 
Parkoilot bei dem eine Messung des Abstands eines Hindernisses zu dem Fahrzeug erfolgt. 
WOM Aus SmTlS 60 81 A1 ist ein Verfahren zur Distanzmessung nach dem Ultraschali-Echopnnz.p fur e n 
Shrzeug betennt Hierbei sind an verschiedenen Stellen des Fahrzeugs Ultraschallsensoren angeordnet, um ,n 
denT^ungsH^ Uitraschallsensoren befindiiche Objekte zu detektieren. Eine Ermittiung der Posrt.on von 

Hindernissen ist mit diesem System nicht moglich. iitrasehall- 
[0003] Aus der DE 43 33 357 A1 ist eine Weiterbildung dieses Verfahrens zur D.stanzmessung nach dem , U trascha I 
EchoDrinSp bekannt Auch bei dieser Weiterbildung wird lediglich der Abstand zu einem H.ndern.s mcht aber cfce 
mit Bezug auf das Fahrzeug erfasst. Bei Unterschreitung ^£^£££<£ 
Hindemis liefert der Ultraschallsensor keine hinreichend genauen Werte mehr, so dass fur *e Best rnmung des Ab 
Sands zu dem Hindemis zusatzlich die durch einen Wegsensor gemessene Wegstrccke ^'^^adarsen- 
[0004] Ferner sind aus dem Stand derTechnik Fahrerassistenzsysteme bekannt, d.e .m AHgeme nen ^^arsen 
soren das heiBt insbesondere sogenannten Short-Range-Radarsensoren (SRH, barren. H.erbe. handelt es s.ch um 
Rnoarksv^ ("Backing Aid"), Auffahrunfalldetekto-en und andere Anwendungen. Auch be. solchen 

SR^baX^ 

von SesTens eta 20 cm bis 50 cm l.efem; bei einem geringeren Abstand liefert ein solcher Radarsensor ke.n fur 
die Abstandsmessung verwendbares Signal. 
20 rOOOSl Der Erfindung liegt die Aufgabe zu Grunde ein verbessertes Fahrerassistenzsystem zu schaffen 

S Sfe der Erfindung zu Grunde liegende Aufgabe wird mit den Merkmalen des unabhang.gen PJ-tanspruchs 
qelost Bevorzugte Ausfuhrungsformen der Erfindung sind in den abhangigen Patentanspruchen angegeben^ 
?000?i' ErfindungsgemaB wind nicht nur der Abstand eines Hindernisses zu dem Fahrzeug, sondem d.e Posrt.on des 
Hindernisses bestimmt Dies erfolgt beispielsweise basierend auf dem Prinzip der Tnangulation. 

TTouthT^ 

dem Fahrzeug und dem Hindemis von zwei verschiedenen Positionen, das heiBt von zwe, an untersch.edhchen Stellen 

des Fahrzeuqs angeordneten Abstandssensoren erforderlich. Doo _» 

raOMl Beispielsweise s.r.d am Fahrzeugheck an der linken und rechten Fahrzeugserte jewe.ls e.n Short-Range- 
SadaLnso T^ZZl Ein hinter dem^ahrzeug befindliches Hindemis wird von beiden 
erfasst und der Attend des Hindernisses zu dem linken und dem rechten Sensor w.rd 

von den verschiedenen Positionen der Sensoren aus ermittelten Abstanden w.rd dann d.e Posrt.on des H.ndern.sses 
mit Bezug auf das Fahrzeug nach dem Prinzip der Triangulation berechnet. 

ro010l Wenn ein Mindestabstand zu dem Hindemis unterschritten wird, liefert zum.ndest e.ner der Radarsensoren 
Sn h Legend glnaues Messsignal mehr, so dass eine Positionsbestimmung des Hindernisses ^ Tnangulat.on 
St mrmoglich ist. ErfindungsgemaB wird deshalb bei Unterschreitung eines Mindestabstands e.ne Weg- und 
Lenkwinkelmessung mit fur die Bestimmung der Position des Hindernisses herangezogen. 

[001^ Alternate zur Lenkwinkelmessung mittels eines Lenkwinkelsensors kann auch d.e G.errate ausgewertet wer- 
den Die Gierrate wird von einem ESP-Steuergeratohnehin ermittelt. . a|rtll 

[0012] Hierzu wird von der .etzten durch Triangulation bestimmten Posrtion des H.ndermsses >"2^J"»"" 
elle Position des Hindernisses ermittelt, indem zu der letzten durch Triangulat.on best.mmten Pos.fon Bewegung 
des Fahrzeugs aufgrund einer Erf assung des von dem Fahrzeug zuriickgelegten Wegs und e.ner Lenkw.nke.messung 

Par'votb^de^m Vortei.isthierbei, dass eine Fahrerassistenz auch imNahbereich, das hei^ 
en des fur die Funktion der Abstandssensoren erforderlichen Mindestabstands, noch 9f wahrle !f^^ da n esem 
Bereich die Positionsbestimmung nicht mittels der Abstandssensoren, sondern mittels Weg- und Lenkwmkelmessung 
ausgehend von der letzten durch Triangulation bestimmten Position erfolgt. 
[0014] Bei der Bestimmung der Position des Hindernisses im "b.inden Bere.ch" w.rd also bevorzugt w.e folg t verge 
gangen. Ausgehend von der letzten bekannten Position, die mittels Triangulation besfmrnt wurde, w. d auf der ^mnd 
Le der Daten der Radsensoren und des Lenkwinkelsensors die nachste Posrt.cn des H.ndern.sses relate zum Fahr 
so zeug bestimmt. Dieses Vorgehen wird von Messzyklus zu Messzyklus wiederholt. Hindernisses 
[0015] Somit kann eine vollstandige Mode.lierung der Trajektorie des Fahrzeugs und der Pos.t.on , des Hjndemeses 
erfolgen das heiBt die Position des Hindernisses ist auch bei Kurvenfahrt immer bekannt ^"d de ssen kann 
fnsbesondere ermittert werden, ob das Fahrzeug bei einer Kurvenfahrt an dem Hindem.s vorberfahn .ode ^ob es be. 
einer Weiterbewegung zu einer Kollision kommt und ein entsprechender Wamh,nwe.s gegeben werden 
55 moi 61 Nach einer bevorzugten Ausfuhrungsform der Erfindung erfolgt die Ermittiung e.ner Kontur des H.ndern.sses 
S^vJJS^Jdar Kontuf mit Hilfe von Abstandssensoren. Uber diese Kontur des Hindernisses w,rd e.ne ^konvexe 
Sedefiniert.Wennein Mindestabstand des Fahrzeugs zu der konvexenHulleunterschntten w.rd, w.rd e.n Wams.gna. 

abgegeben. 
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[0017] Dies ist insbesondere vorteilhaft, wenn in einer Parklucke eines der parkenden Fahrzeuge mit einer Anhan- 
gerkupplung Oder einem anderen herausragenden Objekt versehen ist, welches in den Parkbereich hineinreicht. Der 
Einparkvorgang kann dann aufgrund der die Anhangerkupplung bzw. das herausragende Objekt umfassenden kon- 
vexen Hulle optimiert werden, so dass auch eine Fahrerassistenz bei besonders engen Parklucken gegeben ist. 
5 [0018] Nach einer weiteren bevorzugten Ausfuhrungsform der Erfindung wird ein in dem Fahrzeug oftmals ohnehin 
vorhandenes Electronic Stability Program (ESP) fur die Wegmessung verwendet. 

[0019] Im Weiteren werden bevorzugte Ausfuhrungsformen der Erfindung mit Bezugnahme auf die Zeichnungen 
naher erlautert. Es zeigen: 

10 Rg. 1 ein Fahrzeug mit einem erfindungsgemaBen Fahrerassistenzsystem einer ersten Ausfuhrungsform; 

Fig. 2 ein Fahrzeug mit einem erfindungsgemSBen Fahrerassistenzsystem einer zweiten Ausfuhrungsform; 

Fig. 3 ein Flussdiagramm zur Veranschaulichung der Arbeitsweise einer Ausfuhrungsform eines erfindungsgema- 
15 Ben Fahrerassistenzsystems; 

Fig. 4 ein Flussdiagramm zur Veranschaulichung der Arbeitsweise einer weiteren Ausfuhrungsform des Fahreras- 
sistenzsystems. 

20 [0020] Die Fig. 1 zeigt ein Kraftfahrzeug mit einem Steuergerat 1 . In dem Ausfuhrungsbeispiel der Fig. 1 handelt es 
sich bei dem Steuergerat 1 umein SRR-Parkpilot-Steuergeratzur Realisierung einer Fahrerassistenz fur das Einparken 
mittels Short- Range-Radarsensoren. 

[0021] Das Steuergerat 1 ist mit einem Wegsignalgeber2 verbunden. Als Wegsignalgeber konnen ein oder mehrere 
Raddrehzahlsensoren des Fahrzeugs verwendet werden. 
25 [0022] Ferner ist das Steuergerat 1 mit mehreren SRR-Sensoren 3 verbunden, wobei jeweils vier SSR-Sensoren 3 
entlang des vorderen und des hinteren StoBfangers des Fahrzeugs angeordnet sind. 

[0023] Das Steuergerat 1 ist ferner mit einem Lenkwinkelsensor 4 verbunden. Uber den Lenkwinkelsensor 4 wird 
der Einschlagwinkel der Lenkung des Fahrzeugs erfasst. 

[0024] Ferner ist eine Anzeigeeinrichtung 5 mit einem Ausgang des Steuergerats 1 verbunden. Bei der Anzeigeein- 
30 richtung 5 kann es sich zum Beispiel urn eine optische und / oder akustische Anzeigeeinrichtung handeln; zusatzlich 
oder alternativ kann auch eine haptische Ausgabe vorgesehen sein. 

[0025] Uber die SRR-Sensoren 3 erfolgt die Bestimmung einer Position eines vor bzw. hinter dem Fahrzeug bef ind- 
lichen Hindernisses bei einem Einparkvorgang. Eine solche Positionsbestimmung ist nur dann moglich, sofem dass 
Hindernis von zumindest zwei der SRR-Sensoren 3 an der Vorder- bzw. Ruckseite des Fahrzeugs erfasst wird, so 

35 dass eine Triangulation aufgrund der entsprechenden Abstandswerte durchgefuhrt werden kann. 

[0026] Unterhalb eines Mindestabstands kann eine solche Positionsbestimmung nicht mehr vorgenommen werden, 
da nur ein oder kein Abstandssignal von den SRR-Sensoren 3 geliefert wird. In diesem Fall wird die Position des 
Fahrzeugs mittels der von dem Wegsignalgeber 2 und dem Lenkwinkelsensor 4 gelieferten Signale durch das Steu- 
ergerat 1 vorgenommen. Dies erfolgt so, dass ausgehend von der letzten durch Triangulation bestimmten Position die 

40 Position des Fahrzeugs durch Modellierung der Trajektorie des Fahrzeugs entsprechend des bei einem bestimmten 
Lenkwinkeleinschlag zuruckgelegten Wegs bestimmt wird. 

[0027] Sobald ein definierter Mindestabstand an einer Stelle der AuBenkontur des Fahrzeugs zu dem Hindernis 
unterschritten wird, gibt das Steuergerat 1 uber die Anzeigeeinrichtung 5 ein Wamsignal fur den Fahrer ab. Alternativ 
oder zusatzlich wird das Fahrzeug automatisch abgebremst, um eine Kollision zu verhindern. 
45 [0028] Die Fig. 2 zeigt eine alternative Ausfuhrungsform, bei der zusatzlich ein ESP-Steuergerat 6 vorhanden ist. 
Im Unterschied zu der Ausfuhrungsform der Fig. 1 sind der Wegsignalgeber 2 und der Lenkwinkelsensor 4 nicht un- 
mittelbar an das Steuergerat 1 , sondern an das ESP-Steuergerat 6 angeschlossen. Das Steuergerat 1 erhalt die Weg- 
und Lenkwinkelsignale in diesem Ausfuhrungsbeispiel von dem ESP-Steuergerat 6. 

[0029] Zusatzlich konnen auch seitlich an dem Fahrzeug weitere SRR-Sensoren 3 angeordnet sein, wie in der Fig. 
so 2 dargestellt. Diese seitlich angeordneten SRR-Sensoren 3 konnen zur Erfassung einer AuBenkontur des Hindernisses 
verwendet werden. 

[0030] Typischerweise erfolgt der Einparkvorgang so, dass zunachst an der Parklucke vorbeigefahren wird, um un- 
mittelbar hinter der Parklucke zu stoppen, und dann ruckwarts in die Parklucke hineinzufahren. Bei der Vorbeifahrt an 
der Parklucke erfolgt eine seitliche Erfassung der AuBenkontur von in der Parklucke befindlichen oder in die Parklucke 
55 hineinragenden Hindernissen, wie zum Beispiel einer Anhangerkupplung. Uber die AuBenkontur der die Parklucke 
begrenzenden parkenden Fahrzeuge wird eine konvexe Hulle gelegt, in die die Begrenzung des einzuparkenden Fahr- 
zeugs nicht eindringen darf, das heiBt das Fahrzeug muss bei dem Einparkvorgang einen vorgegebenen Mindestab- 
stand von der konvexen Hulle einhalten. Dadurch wird ermoglicht, dass auch bei in die Parklucke hineinragenden 
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Hindernissen. wie zum Beispiel einer Anhangerkupplung, derfurdas Einparken nutzbare Raum optimal genutzt werden 

SoSIl Die Fig 3 veranschaulicht den Ablaut beim Betrieb des erfindungsgemaBen Fahrerassisten ^ yste ^ n ' r ; n d ^ r 
sSm 30 S die BeSmmung der Position eines Hindernisses mit Bezug auf das Fahrzeug nach dem Pnnz. P der 

SgnaUu dem erfassten Hindemte.iefem. Dies ist bei Unterschreitung eines Mindestabstands zu dem H.ndern.s n.cht 

raS 6 Wenn von den Abstandssensoren hinreichende Abstandssignale vorliegen, geht die Ablaufsteuerung zuruck 
zu dem Schritt 30 urn die aktuelle Position des Hindernisses mit Bezug auf das Fahrzeug emeu zu best.mmen^ 
[OoST .sJ edoc'h das Gegenteii der Fali, das heiBt liegt nur ein oder kein hinreichende* ^^^^ 
standssensoTen vor, da der Mindestabstand unterschritten worden ist. geht die Ablaufsteuerung zu dem Schnfl 32 In 
dem tSET-Ew die Bestimmung der Position des Hindernisses mit Bezug auf das Fahrzeug b~^-*£ 
Sent dem Schritt 30 ermrttelten Position des Hindernisses. wobei der von dem Fahrzeug sert de r totten Posrti 
!£!£!i!^ng zuruckgelegte Weg vektoriel. aufgrund der Lenkwinke.bestimmung aufadd,ert w.rd. Auf d.ese Art und 
Weise erhalt man die Position des Hindernisses im Nahbereich. 

m035] Nach dieser Positionsbestimmung Im Schritt 32 geht die Ablaufsteuerung zuruck zu dem Schntt 31 . urn zu 
prufen, ob hinreichende Slgnale von den Abstandssensoren vorliegen. «„ efomK ,„ rtpm schritt 40 

ra0361 Die Fig. 4 zeigt eine weitere bevorzugte Ausfiihrungsform des FahrerassKtenzsystems^ In A*r Sch rtt 40 
Eefem die aW SRR-Sensoren ausgebildeten Abstandssensoren hinreichend genaue Abstandswerte, so ^ chePo- 
sl etes Hindernisses mittels Triangu.ation bestimmt werden kann. Die aufgrund ^^^^^ 
Fahrzeugtrajektorie wird mit dem Wegsignalgeber und / oder dem Lenkwmke.sensor abgegUchen, urn e.nen Korrek 

S TdTm Schritt 41 erfolgt die Navigation im "b.inden Bereich". das heil* in einem Bereich von weniger cm. 
20 cm bis 50 cm von dem Hindemis entfemt. In diesem Bereich wird mittels Koppe.navigat.on nav,g,ert ,4m ^ 
IZte Hrndernisposttion wird ausgehend von der letzten durch Triangu.ation best.mmten Pos.tton durch vektone.le 

roilf Tn^ Hernia und dem Fahrzeug ein Ohjekt bef indet. Wenn 

di~ der FalMsT wirSn dem SchriS 43 eine optische und / oder akustische und / oder haptische Warnung abgegeben. 
fst ket solcnes oSekt vo^anden, so wird in dem Schritt 44 gepruft. ob sich ein Punkt der FahrzeugauBenkontur 
LowranTs Hindemt angenahert hat. dass ein minimaler SicherheKsabstand unterschritten worden ,st. Wenn d,es 
STSTtaJ ! wird der Schritt 9 43 ausgefuhrt. Wird der Sicherheitsabstand nicht unte^chritten. so w,rd der Schntt 44 
ausgefuhrt, das heiBt es erfolgt keine Warnung. 

Bezuqszeichenliste 

[0039] 

Steuergerat 1 

Wegsignalgeber 2 

SRR-Sensoren 3 

Lenkwinkelsensor 4 

Anzeigeeinrichtung 5 

ESP-Steuergerat 6 

Patentanspriiche 

1 . Fahrerassistenzsystem fur ein Fahrzeug mit 

- Mitteln (3) zur Bestimmung einer ersten Position eines Hindernisses mit Bezug auf das Fahrzeug, solange 
das Fahrzeug einen Mindestabstand zu dem Hindernis hat, 

- Mitteln (2)zur Bestimmung einer zweiten Position des Hindernisses bei Unterschreitung des Mindestabstands 
basierend auf einer Weg- und Lenkwinkelmessung. 

2 Fahrerassistenzsystem nach Anspruch 1 , bei dem die Mittel zur Bestimmung einer ersten Position eines Hinder- 
^S^^^mehraia RadaLnsoren, vorzugswe.e Short-Range-Radarsensoren (SRR) e.nen oder men- 
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rere Ultraschall- Oder optische Sensoren aufweisen. 

Fahrerassistenzsystem nach Anspruch 1 Oder 2, bei dem die Mittel zur Bestimmung einer ersten Position eines 
Hindernisses erste Sensormittel zur Bestimmung einer ersten Entfemung des Fahrzeugs von dem Hindernis und 
Mittel zur Bestimmung einer zweiten Entfemung des Fahrzeugs von dem Hindernis aufweisen und Mittel zur Be- 
rechnung der ersten Position mittels Triangulation aus der ersten und der zweiten Entfemung. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 , 2 oder 3 mit 

Sensormitteln zur Ermittlung einer AuBenkontur des Hindernisses, 

Mitteln zur Festlegung einer konvexen Hulle um die AuBenkontur des Hindernisses, 

Mitteln zur Abgabe eines Signals, wenn ein Mindestabstand des Fahrzeugs von der konvexen Hulle unter- 
schritten wird. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 4 mit Mitteln (1) zur Umschaltung der 
Bestimmung der Position des Hindernisses von den Mitteln zur Bestimmung einer ersten Position zu den Mitteln 
zur Bestimmung einer zweiten Position, wenn eine Unterschreitung des Mindestabstands zu dem Hindernis de- 
tektiert wird. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 5, wobei die Mittel zur Bestimmung einer 
zweiten Position des Hindernisses zur Erfassung der von einem oder mehreren Raddrehzahlsensoren gelieferten 
Signale fiir die Wegmessung ausgebildet sind. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 6, wobei die Mittel zur Bestimmung einer 
zweiten Position des Hindernisses zur Erfassung der von einem Electronic Stability Program (ESP) (6) abgege- 
benen Signale fiir die Wegmessung ausgebildet sind. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 7 mit Mitteln zur automatischen Abbrem- 
sung des Fahrzeugs, wenn ein Sicherheitsabstand zu dem Hindernis unterschritten wird. 

Fahrerassistenzsystem nach einem der vorhergehenden Anspruche 1 bis 8, wobei es sich um einen Parkpilot, 
eine Backing Aid, einen Auffahrunfalldetektor oder dergleichen handelt. 
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SRR-Sensoren liefern Abstandswerte: Abgleich. mit den 
Messungen der Radsensoren 
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Navigation im blinden Bereich (ca.< 50cm): Ennittlung des 
Sicherheitsabstandes bis zum Hindemis auf Basis der letzten 
Messung der Umfeldsensoren, der Messungen der 
Radsensoren und des Lenkwinkelsensors 
(zyklische Errnittlung der Position des Hindernisses) 


nein 


keine Wamung s 


optische/akustische 
Wamung 
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